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ABSTRACT 


Collision-free motion of two robot arms in a common workspace 
is investigated in this report. A collision-free motion is obtained by 

detecting collisions along the preplanned trajectories using a sphere 
model for the wrist of each robot and then modifying the paths 
and/or trajectories of one or both robots to avoid the collision. 
Detecting and avoiding collisions are based on the premise that: 

1) preplanned trajectories of the robots follow a straight line, 2) 
collisions are restricted to be between the wrists of the two robots 

(which correspond to the upper three links of PUMA manipulators), 
and 3) collisions never occur between the beginning points or end 
points on the straight line paths. In this report, the collision 
detection algorithm is described and some approaches to collision 

avoidance are discussed. 
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1. INTRODUCTION . .. 

Industrial robots have made significant contributions in 
automating the manufacturing process. They are general purpose 
manipulators consisting of a series of rigid links connected together 
by revolute or prismatic joints. Mechanically, a typical robot has a 
supporting base, an arm unit, a wrist unit, and an end effector or 
tool. Movement of the arm unit usually consists of three degrees of 
freedom in which a sequence of movements can position the wrist 
unit at some desired location in the workspace. The wrist unit, 
typically consisting of two or three rotary joints, orients the end 
effector in such a manner to perform the tool task. The wrist unit 
usually provides a mounting plate so that various types of end 
effectors, such as grippers, welding guns, or electro-magnets, can be 
attached. Typical robot configurations are shown in Fig. 1 and Fig. 2. 

Presently, the number of robots being used in industrial and 
commercial applications is increasing at a rate of about 35 percent 
per year [1]. Manufacturers find that robots can increase 

productivity, reduce production costs, and improve product quality. 
However, the robots currently in use perform simple repetitive jobs 
such as pick-and-place tasks, machine loading and unloading, spray 
painting, and spot welding. Recent advances in such technologies as 
robot sensors and vision systems will allow more complex tasks to 
be performed. The development of intelligent robots is essential for 
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Figure 2 Six Degree Freedom Revolute Robot 

increasing the industrial and commercial uses of robots [2], [3]. 

In a fully automated manufacturing environment, sophisticated 
robot systems should be able to handle nearly all manufacturing 
operations. In such an environment, robots must work together and 

perform their tasks in a coordinated manner to fully utilize the arms 
and the workspace. However, such robots could become obstacles to 
each other without proper strategy and, therefore, require 
collision-free paths between their end effectors. Techniques for 

controlling robot arms in a common workspace will demand 
trajectory planning schemes, collision detection algorithms, and 

collision avoidance strategies. These demands motivate the research 
that constitutes this report. 

1.1. Multiple Robot Arms 


Robots in the future are likely to possess human-like dexterity. 
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Robot arms will probably perform sophisticated tasks in the same 
manner as do human arms and hands. Presently, research in 
multiple arm coordination and control is just beginning. The 

performance of simple tasks, such as lifting an object by two robots 
or providing collision-free motions, is still difficult. 

Since utilizing only one robot to operate in a workspace limits 
the amount of tasks that can be performed, the use of two or more 

robots is essential to improve the versatility of potential 

applications. To complete a task, several robots can be used with 

each performing its specific small subtask which allows for an 
increase in productivity. Along with an increase in productivity, 

multiple arms can perform complex tasks, such as lifting objects that 
are beyond the weight limits of a single arm and assembling 

sophisticated equipment, that cannot be performed by a single robot 
but require the use of two or more working together. In addition, 

certain applications require coordination between robots to save 

time in completing a task. 

Roach [4] classifies coordinated actions of two robot arms into 
four categories: 

1) Symbiotic Actions - A class of actions where one hand aids 

the other in a passive way. For example, a nail must be held 
upright while hammering it. Holding a tooth brush while 
applying tooth paste is another example. 

2) Compliant Actions - A class of actions involving hands 
performing similar movements at different places, usually 
on the same object. For instance, two hands lifting a pan of 
water must move together to prevent spillover. 
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3) Co-operative Actions - A class of actions where hands are 
actively performing actions that are not the same but 
require coordination. Tying shoelaces is an example. 

4) . Countervailing Actions - A class of actions where hands 

assist each other by performing actions that are apparently 
opposed. For instance, glueing two pieces of tile together is 
performed by applying pressure to each one. 

Cooperating robots in a common workspace must be coordinated in 
order to avoid collisions between them. The research reported in this 
paper is directed at coordination and control of two robots in a 
common workspace through collision-free motion planning. 

1.2. Problem Formulation 

The motivation for studying the problem of using multiple arms 
and controlling robots in a common workspace should now be clear. 
This investigation, without the loss of generality, deals with the case 
of only two robots. When two or more robots are used in a common 
workspace, they may become obstacles to each other and, therefore, 
motion planning must include detection and avoidance of collisions 
between them. A collision-free motion is obtained by detecting 
collisions along the straight line trajectories of the robots and then 
replanning the paths and/or trajectories of one or both of the robots 
to avoid the collision. 

The straight line path and trajectory information of each robot 
is used to detect whether collisions exist. Collisions are restricted to 
be between the wrists of the two robots (which correspond to the 
upper three links of PUMA manipulators). A sphere model for the 
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wrist (including the tool and any grasped object) is used because it is 
rotationally invariant and computationally efficient compared to 
other geometric models such as the cone and cylinder models (Fig. 
3). Collisions are assumed never to occur between the beginning 
points or end points on the straight line paths. This problem is 
handled by a higher level planner which guarantees that the 
operations of the robots are valid, and, therefore, they never attempt 
to access a specific location in the workspace at the same time. 

The collision detection method involves two steps: 1) obtaining 
the range of potential collisions along the straight line trajectories of 
the two arms without considering the motion characteristics, and 2) 
mapping the potential collision range information into the time 
domain to obtain the space-time collisions. Once the collision region 
in time and space is found, a collision-free motion is obtained by 
producing new paths and/or trajectories for the robots based on 
various collision avoidance techniques. 

1.3. Background 

Methods for coordinating multiple arms that are currently being 
investigated by several researchers range from using low-level 
kinematics and dynamics to developing high-level motion planners. 
Various approaches in dual-arm control consider master/slave 
relationships between the robots using position and/or force 
feedback. Ishida's [5] force control method is based on a two arm 

transport system run in a master/slave mode. In this method, the 

fundamental movements are parallel transfer and rotational 
transfer, but more complex motions can be accomplished if 



robot 1 


robot 2 


robot 1 


robot 2 


Cylindrical Model 


Truncated Cone Model 


(O O, 

robot 1 robot 2 


Sphere Model 


Figure 3 Commonly Used Wrist Models 
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combined. A wrist force sensor measures the interactive force 
between the two arms. The master arm is position controlled while 

the slave arm is entirely force controlled and free to move where 

necessary to follow the master. Alford and Belyen [6] use a 

hierarchical computer control structure to perform a type of 
master/slave coordination. The master is position controlled for a 

desired trajectory and the slave follows relative to the master’s path. 
The slave arm’s trajectory is modified in real time based only on the 
position of the master and not on any force/torque sensor 
information. Tarn, Bejczy, and Yun [7] have developed a control 
method to transfer an object along a desired trajectory using two 
robots. The robots work in a master/slave mode in which the slave 

robot follows the master by keeping a constant offset distance. Their 
control method uses a dynamic coordinator acting on relative 

position and velocity errors and/or on relative force/torque errors 
between the two arms. Zheng and Sias [8] use wrist force sensors to 
detect contact between two robot arms. The force information is 
used to adjust the relative positions and orientations of the arms to 
continue their assembly task. Hayati [9] uses hybrid position/force 
control for cooperation between two or more robots that are rigidly 
holding an object by allowing the arms to control the position and 

force on a designated point on the object. 

The above approaches provide partial solutions, with various 
degrees of success, to the problem of robots physically operating 

simultaneously on a common object. However, they do not address 
the problem of coordinating robots that are working on separate 
tasks in a common workspace. In such an environment, collision-free 
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motions are required for the robots to safely perform their 

designated jobs. 

However, most of the current collision avoidance schemes are 
directed toward avoiding contact between a robot arm -.and 
stationary objects in the work environment. Udupa [10] introduces 
the concept of transforming a robot into a point to find open paths. 
Brooks [11] represents free areas in forms of generalized cones 

through which the robot can travel. Lozano-Perez and Wesley [12] 
use a visibility graph to create a configuration space that represents 

corners of obstacles between which straight line travel of the 

manipulator is possible. In addition, Lozano-Perez [13], [14] provides 
approaches to the findpath and findspace problems using polyhedral 
representations of manipulator configurations that would produce 
collisions. Chien, Zhang, and Zhang [15] use the concepts of state 
space and rotation mapping to create a set of relationships between 
the positions and the corresponding collision-free orientations of a 

robot among obstacles. Finding collision-free paths for robots using 

this method is reduced to considering the connectivity of the graph 
represented by the set of relationships. A graphical simulation 

approach using configuration maps to plan manipulator paths in a 
two-dimensional workspace is given by Red and Truong-Cao [16]. 
Gilbert and Johnson [17] provide an approach to path planning by 

solving an optimal control problem with state constraints that ensure 
obstacle avoidance. The constraints are expressed in terms of the 
distance between potentially colliding parts of the robot and the 
obstacles. Kambhampati and Davis [18] use hierarchical 

representations based on quadtrees and staged path searching 
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methods for achieving collision-free paths. In a similar manner, 
Wong and Fu [19] use hierarchical path searching methods in three 
orthogonal two-dimensional projections of the three-dimensional 
environment to find a collision-free path. Oommen and Reichstein 
[20] provide algorithms for moving a manipulator represented by an 
ellipse among elliptical obstacles. A method for finding the minimum 
time motions for a manipulator between given end states with 

obstacle avoidance is given by Dubowsky, Norris, and Shiller [21]. A 
penalty function is used to account for the presence of obstacles and 
to provide constraints on the motion of manipulator joints. Recently, 
Singh and Wagh [22] have provided a path planning algorithm using 
intersecting convex shapes. A graph consisting of nodes representing 
all the largest rectangular free areas is created with intersecting 

areas being adjacent nodes. A cost function is utilized to find the 
path from the source node to the destination node in the graph. Rueb 
and Wong [23] structure free space into a set of overlapping convex 
regions which can be represented as a hypergraph. They introduce 

an approach to search the graph to obtain the characteristics of the 
robot's environment. 

A literature review of all research directed at collision-free 

motion planning of multiple robots indicates that only a small 
amount of effort has been devoted to the problem of collision 
detection and avoidance. Gouzenes [24] proposes the use of 
graph-search techniques and petri-nets for collision avoidance 
between robots during an assembly operation. DuPourque, Guiot, and 
Ishacian [25] address distributed environments for multi-robot 
controllers using a hierarchical organization in which higher levels 


perform the coordination, synchronization, and communication. 
Freund and Hoyer [26], [27], [28] provide an approach to collision 
avoidance by using a systematic design method for multi-robot 
systems. They propose a hierarchical structure for .multi-robot 
systems using the dynamics of all the robots and a hierarchical 

coordinator for achieving collision-free paths. Canny [29] outlines a 
collision detection scheme for two moving robots represented as 
polyhedral objects. Tournassoud [30] uses the concept of separating 
hyperplanes to obtain avoidance between two manipulators. Fortune, 

Wilfong, and Yap [31] present a technique for motion planning for 
independent but synchronized motions of two robot arms each of 
which has two degrees of freedom movement. A joint feasible region 
is constructed that represents the set of placements of the arms that 
neither intersect the interior of an obstacle nor each other. Some of 
my past work [32] demonstrates the use of a concurrent processing 

environment to provide a collision-free coordination of 

independently controlled robots in a common workspace by using 
the techniques of concurrent programming and solving the problems 
of mutual exclusion, synchronization, and communication for a 
desired coordinated task. Roach [4], [33] discusses coordinating the 
collision-free motions of robot arms through the use of a robot 
operating system consisting of a task level planner, an execution 
monitor to govern execution, and low-level processes to control the 
robots. 

Recently, Lee and Lee [34] have proposed an approach to 
collision-free motion planning of two robots by detecting and 

avoiding collisions using discrete time, straight line trajectories. As in 
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the detection and avoidance techniques presented in this report, 
they consider collisions to be between the wrists of each robot which 
are represented by sphere models. However, their discrete time 
approach must be performed off-line due to the time requirements 
in detecting collisions and calculating a collision region bounding box. 
Also, collisions that occur between discrete time instants cannot be 

accurately detected. In addition, their collision avoidance scheme is 

restricted to modify the path or trajectory of only one of the two 
robots. 

This report investigates collision-free motion of two robots in a 
common workspace by detecting collisions along the straight line 
trajectories of the robots and then replanning the paths and/or 
trajectories of one or both of the robots to avoid the collision. The 
algorithm for collision detection is presented in Chapter 2. Various 

approaches to collision avoidance are presented in Chapter 3. Finally, 

Chapter 4 contains conclusions and future research that follows from 
this report. 
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2. COLLISION DETECTION . . \ 

As discussed earlier, the sphere model for the wrist (Fig. 4) is 
used to detect and avoid collisions due to the fact that it - is 
rotationally invariant and computationally efficient compared to 
other geometric models. The detection of a collision is accomplished 
by calculating the distance between the origins of two spheres. A 
collision is said to occur between the two wrists at any given time 
instant if the distance between the center of the two spheres is less 
than or equal to rl+r2. 



Figure 4 Sphere Model 

One possible method of detecting collisions is to check at 
carefully chosen discrete time instants if the two spheres collide. As 
mentioned earlier, Lee and Lee [34] adopted this approach in which 
motion planning using such a collision detection technique had be 
done off-line. 

The collision detection technique presented here involves 
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finding the segments on the straight line paths of the two robots 

where the possibility of collisions between the two wrists exists. 

Specifically, for each of the two straight line paths, a segment is 

found where, for each point of that segment, there exists at -least- one 

point on the other path which is less than or equal to rl+r2 distance 
apart. Such possible collisions, from now on, are referred to as 
potential collisions (i.e., collisions without considering the motion 

characteristics of the two robots). Since the ultimate objective is to 
avoid collisions, only the locations on each path where potential 
collisions begin and end are required to be determined. Once these 
points are known, trajectory information for each path can be used 

to determine if the potential collision is also a space-time collision 
(i.e., collisions taking motion characteristics into consideration). The 

overall approach to collision detection is explained in sections 2.1 
and 2.2. 

2.1. Detecting Potential Collisions 

The position of a robot in three dimensional space (R ) is 
defined by the center of the sphere representing the wrist with 
respect to a fixed global coordinate system (x,y,z). Any movement of 
the robot is represented by the path taken by the center of the 
sphere. Therefore, the straight line path of a robot, r, is specified by 
an initial point (x ri ,y ri ,z ri ) and a destination point (x ff y r f,z rf ). 

The detection of potential collisions involves finding the 
segments on the straight line paths of the robots where the 
possibility of collisions between the two wrists exists. Let the 
parametric equations of the straight lines representing the paths of 


the two robots be 
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p, = p n + «p lt - p u > 

^2 = ^2i + Y(P2f " ^2^ (1) 

where 0<X<1 and 0<y<l. For a potential collision to occur, 

II Pj - P 2 II < rl + r2. (2) 

Another way of computing the potential collisions is to obtain 
the intersections of a straight line representing one of the two paths 
with the locus of the surface of a sphere of radius rl+r2 whose 
center moves along the straight line representing the other path. 
This is equivalent to expanding the radius of the sphere of one robot 
by the radius of the other sphere while shrinking the other sphere to 
a point. 

It is obvious in the case of straight line paths that there will be 
a continuous segment where the potential collisions exist. Fig. 5 
shows potential collisions for two-dimensional paths through the use 
of a 2-D-Wrist-Potential-Collision Diagram (WPCD) in which each 
path contains its segment where potential collisions begin and end. 


2.1.1. Generating Potential Collision Regions 

In the standard cartesian coordinate system, a sphere of radius 
r=rl+r2 and center ( x c >y c .z c ) is given by the equation 

(x - x c ) 2 + (y - y c ) 2 + (z - z c ) 2 = r 2 . (3) 

Letting the center of the sphere move along the path of robot 1, the 
straight line path of robot 1 can be parametrically defined as 


y c = y n + bjX 

z c ■ z li + c l* 


0 < A .<1 


(4) 



16 


collision 

length 



Figure 5 2D-Wrist-Potential-Collision Diagram (WPCD) 


where 

a l = x lf ' x li 

b i = Xu - yn 

C 1 = z lf ' z li * 


(5) 


The straight 


line path of robot 2 can be expressed as 


x = x 2i + 327 

y = y 2i + b 2 y 

z=z 2i +c 2? 0<7<i (6) 

where 

a 2 = x 2f ' x 2i 

b 2 = yu - yn 

C 2 = z 2f ‘ z 2i * (7) 


Thus, seven simultaneous equations with eight unknowns are 
formed. To generate the potential collision regions, equations (3), (4), 




and (6) are combined to obtain 


where 


and 


Vectorially, equation (8) can be expressed as 

II A 2 y - AjX + K II = r . ) 

where 

Aj = (a^jbjjCj) 

^2 = ^ 2 ^ 2 tC 2 ^ 

K =(k x ,k y ,k z ) (17} 

which provides the positions along the straight line paths of robot 1 
and robot 2 that are distance r apart. 

For a given value of X in equation (8), zero, one, or two values of 
Y can be found. This is equivalent to obtaining no intersections, one 
intersection, or two intersections with the other path for a f iver 
location of the sphere on its path. In case of two intersections,, the 
distance on the straight line path between the two intersection 
points is called the potential collision length. Thus, equation (8) 


k x y 2 - 2k 2 YX + k 3 X 2 + 2k 4 y - 2k 5 X+ k g = 0 


k l = a 2 2 + b 2 2 + c 2 2 . - -O) 

k 2 = a^ + bjb 2 + CjC 2 (10) 

k 3 = aj 2 + bj 2 + c t 2 (II) 

k 4 = k x a 2 + k y b 2 + k z C 2 O 2 ) 

k 5 =k x a l + k y b l + k z C l '.(13) 

k 6 " *Sc 2 + k y 2 +k z 2 -^ (14) 


k y = *2i - Xli 
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represents the location of the intersection points with respect to X (or 
vice versa with respect to 7) producing a parametric space potential 
collision region. A typical region is shown in Fig. 6 on a 

Parametric-Space-Potential-Collision-Region Diagram (PSPCRD). The 
ellipse in Fig. 6 is the most common case for parametric space 
potential collision regions and is discussed later. As stated earlier, 
only the segment on each path where potential collisions exist is 
required. The four extreme points of the ellipse are found by 

computing its horizontal and vertical tangents. These points, , 

Yicp, X fcp , and , represent the locations on each path where 
potential collisions begin and end. 

2.1.2. Analyzing Potential Collision Regions 

Equation (8) is a second-degree equation in two unknowns, X 
and 7, where kj, 1^, and k 3 cannot all be zero. The values of kj and 
k 3 are never zero due to the fact that the direction vector of a line 
must contain at least one non-zero element. Equation (8) defines a 
potential collision region in terms of parametric variables X and 7. 
Unless equation (8) degenerates into straight lines, shrinks to a 
point, or is purely imaginary, it represents one of the following cases: 


1) 

a hyperbola 

if 

k 2 2 - kjk 3 > 0 

( 18 ) 

2) 

a parabola 

if 

k 2 2 - kjkj = 0 

( 19 ) 

3 ) 

an ellipse or 

if 

k 2 2 - kjk 3 < 0; a circle when 

(20) 


a circle 


k 2 = 0 and k^ = k 3 . 
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Figure 6 Parametric-Space-Potential-Collision-Region 
Diagram (PSPCRD) 


A hyperbola will never be generated because application of the 
definitions from (17) to (18) produces the vector equation 

Aj • A 2 > II Aj II II A 2 II (21) 

which can never occur since the Cauchy-Schwarz Inequality shows 

that 

IX • Yl < II X II II Y II (22) 

where X and Y are vectors in R 3 . 

A parabola is generated when k 2 2 = kjk^. This occurs when the 

paths of the robots are parallel. However, for this case, the 
parametric space potential collision region is the limiting form of a 
parabola which consists of a pair of parallel lines or a single line 

counted twice. 

An ellipse is the most common case for the parametric space 

potential collision region. A circle is a limiting form of an ellipse and 
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occurs when k 2 =0 and kj = k 3 . Coefficient k 2 equals zero when the 

direction vectors and, therefore, when the paths of the robots are 
perpendicular. When the sphere is cut by a perpendicular line, ~ the 
distances of two new collision points from their corresponding 

previous collision points are equal producing a circular potential 
collision region. However, since the rate of change in X and y per unit 
path length may differ, perpendicular paths may still produce 

elliptical potential collision regions in X and y if the same scale is 
utilized. Therefore, the magnitudes of the paths must be equal 
(k x =k 3 ) for a circle to be generated in the PSPCRD. When the paths of 

the robots are not perpendicular, an ellipse is generated because the 
distances of two new generated collision points from their 
corresponding previous collision points are unequal. 

When the roots of equation (8) are imaginary, potential 
collisions and, therefore, space-time collisions do not exist. Equation 
(8) degenerates into straight lines when the paths of the robots are 
parallel and this represents the parabola case. A single root of 

equation (8) can exist representing a point collision. In summary, 
points, lines, and ellipses are the possible collision regions that can 
occur in the PSPCRD as depicted in Fig. 7. 

2.1.3. Determining Potential Collision Segments 

As shown in section 2.1.2, points, lines, and ellipses are the 
possible collision regions that can occur in the PSPCRD. The PSPCRD 

can be divided into nine sub-regions as shown in Fig. 8. Each 
sub-region specifies where on the paths of the two robots the 
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Point Collision Region 





Ellipse Collision Region 


Figure 7 Possible Potential Collision Regions 


22 



Figure 8 The Nine Sub-Regions of the PSPCRD 

collision is occurring. Sub-regions with corresponding values of X and 
y that are less than zero or greater than one are indicating points that 
exist on the lines containing the robots' paths but are before the 
starting points and after the ending points of the paths, respectively. 
Sub-region 1 contains the potential collision information that occurs 
along the paths of the robots. Other sub-regions correspond to the 
invalid locations of potential collisions. 

As discussed, only the four extreme points (smallest and largest 
values of X and y) in sub-region 1 are required. These values 
represent where collisions begin and end on each path. However, a 
single root (point collision) requires finding only the one value of X 
and y causing the collision. The point can exist in any of the nine 
sub-regions of which only sub-region 1 contains a valid collision. 
Otherwise, a potential collision and, therefore, a space-time collision 
does not exist. Detection of a point collision involves finding the 
minimum distance between the lines representing the paths of the 
robots. The minimum distance between the lines containing the 
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paths of the robots can be found by differentiating the equation 

d 2 = kjY 2 - 21 ^- yX + k 3 X 2 + 2k 4 y - 2k 5 X+ k ? (23) 

where 

d is the distance between the two lines, kj to k 5 are the 
same as. in equation (8), and k ? = k x + k y + k z 

with respect to X and y and solving the results simultaneously to 
obtain 

y ~ (^2^5 - k 4 k 3 )/(k 1 k 3 -k 2 2 ) (24) 

X — (1^2 Y kj)/k 3 . (25) 

Equations (24) and (25) provide the condition for minimum distance 
between the lines since the second derivatives of equation (23) with 

respect to y is kj and with respect to X is k 3 which are always greater 
than zero. If the minimum distance is equal to r and is along the 
robot paths (0<A,< 1 ,0<Y^ 1), then a point collision occurs at those 
particular values of X and y. If the minimum distance lies outside the 
paths of the robots, then checking whether collisions exist at the 
starting and finishing points (end points) of the two paths will 
provide the necessary information since the paths are converging. A 
collision exists at an end point when the sphere placed at that end 
point produces a valid intersection (0< X £1 orO<y^l) with the other 
path. Placing the sphere at each of the four end points is 
accomplished by solving equation (8) for A,=0,. A.=l, y= 0, and *y=l. A 
point collision occurs whenever: 1) one end point has only one 

intersection that is valid, or 2) two end points have only one valid 
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intersection of which each is at the end point of the other line. In 
either case, the collision point occurs at the end point of one path 
with either the end point of the other path or a location along the 
other path defined by the single intersection. 

A similar procedure is applied to paths that are parallel with 
the requirement that four extreme values are needed. If the 
minimum distance between the parallel lines representing the 

robots' paths is greater than r or if no end points provide a valid 
intersection, then a potential collision and, therefore, a space-time 
collision does not occur. Each end point that is found to produce a 
potential collision is one of the extreme values. Any missing values 
are then determined from the valid intersection points. Such needed 
information can be obtained from sub-region 1 of the PSPCRD. 

As mentioned earlier, the elliptical parametric space potential 
collision region is the general case. It is produced by all combinations 
of paths that result in potential collisions with the exception of those 
that are parallel or result in point collisions. The ellipse case 
represents a complete collision, one that begins and ends, along the 
lines that represent the paths of the robots as seen in the WPCD of 
Fig. 5. The four extreme points of the ellipse are found by calculating 
its horizontal and vertical tangents through implicit differentiation of 
equation (8) with respect to X and y. The equations producing the 
horizontal tangents (maximum and minimum values in y) are 

(k 1 (k 3 /k 2 ) 2 -k 3 )X 2 + ((2k 3 /k 2 )(k 4 -(k 5 k 1 )/k 2 ))^. + 

(k 1 (k 5 /k 2 ) 2 -(2k 4 k 5 )/k 2 +k 6 ) = 0 (26) 


y = (k 3 X- k 5 ) / k 2 


(27) 
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and producing the vertical tangents (maximum and minimum values 
in X) are 

(k 3 (k 1 /k 2 ) 2 -k 1 )y 2 + ((2k 1 /k 2 )((k 3 k 4 )/k 2 -k 5 ))Y + 

(k 3 (k 4 /k 2 ) 2 -(2k 4 k 5 )/k 2 +k 6 ) =0 (28) 

X = (kjY + k 4 ) / 1^ . (29) 

The horizontal and vertical tangents provide the information ~ for 
determining the four extreme values (smallest and largest values of 

X and y) that represent the locations on each path where collisions 

begin and end. If the tangents are imaginary, potential collisions and, 
therefore, space-time collisions do not exist. If they are valid 
(complete collision occurs along the path of both robots), an elliptical 
pararmetric space potential collision region is generated in 
sub-region 1 of the PSPCRD. Thus, the four extreme values are 

known from the four tangent values. 

However, tangents are invalid when they are generated in any 

sub-region of the PSPCRD except sub-region 1. Each invalid tangent 
is produced by an extreme collision that occurs on the lines 

representing the paths, but not on the paths, of one or both of the 

robots. When three tangents are valid (0<X<1 and O^Y^l). the fourth 
lies in section 3, 5, 7, or 9 of the PSPCRD. The missing extreme value 
is the end point (0 or 1) of one of the paths and can be found by: 1) 
placing the sphere on the end points of the path with the missing 

extreme and determining which end point has valid intersections, 2) 
using the known three extreme values to determine which end point 

must be the fourth, or 3) using the sign of the missing value from 
the invalid tangent to determine which end point of the path has 
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been surpassed. 

A similar but more complicated procedure for determining the 
extreme intersection values is followed when zero, one, or two 
tangents, are valid. The invalid tangents can lie in any of the nine 
sub-regions of the PSPCRD except sub-region 1. When zero, one, or 
two tangents are valid, each end point that is found to produce a 

collision is one of the extreme values. Any missing values are then 

determined from the valid intersections. Sub-region 1 of the PSPCRD 
contains all the required information. This procedure is similar to 

that when the paths are parallel. However, the sphere is only 

required to be placed at the end points that produce the invalid 
tangents. Each of these endpoints are determined using the sign of 
the missing extreme value from the invalid tangent. When all 

tangents are invalid and no end points produce an intersection, a 
potential collision and, therefore, a space-time collision does not 

occur. Fig. 9 provides examples of the ellipse case. 

2.2. Detecting Space-Time Collisions 

Once the locations on each path where potential collisions begin 

and end are known (^i cp Af C p,Y iC p,Yf C p)» trajectory information can be 

used to determine whether a space-time collision exists. If a 
space-time collision is likely to occur, it has to happen within the 

potential collision segment on each robot's path. Using trajectory 

information (velocity, acceleration, and location of break points), the 
time range when the potential collisions along each path occur can be 
determined. Any overlap in the two time ranges suggests, but does 
not guarantee, the existence of a space-time collision. It is obvious 
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that the robots can simultaneously be within their potential collision 
segments and never collide in time. For example, one robot can be 
leaving its potential collision segment while the other robot is just 
entering, its segment. If these locations are not within colliding 
distance, no space-time collision will occur. In other words, common 
time ranges relate information that each robot is colliding with every 
location on the potential collision segment of the other robot. This, of 
course, is incorrect. Therefore, an overlap in the time ranges when 
potential collisions occur is necessary, but not a sufficient condition, 
for determining if a space-time collision is going to happen. 

Thus, the method of detecting space-time collisions involves two 
steps: 1) determination of an overlap in the time ranges when 

potential collisions along each path occur to assure the possibilty that 
a space-time collision can happen, and then 2) establishment of the 
existence of a space-time collision. 

2.2.1. Determining Common Time Ranges 

Using the trajectory information of a robot, the distance 
traveled along its straight line path per unit time can be calculated. 
Letting distance traveled be defined by a parametric position, the 
following equations can be defined: 


*=f x (t) 

(30) 

Y=f/0 

(31) 

ii 

»-*3 

/'—v 

(32) 

t 7 = f Y 1 (y). 

(33) 


Equations (30) and (31) give the parametric positions on each path 
where the robots are located in time, and equations (32) and (33) 
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perform the inverse which provides the time at which the robots 
reach specific locations along their paths. 

Using the time equations (32) and (33), the time range when 
potential collisions along each path occur can be determined. If an 
overlap in time ranges does not occur, a space-time collision cannot 
exist since a collision is only possible within the potential collision 

segment on each path. As stated earlier, if the time ranges overlap, a 

space-time collision may or may not occur. A 
Space-Time-Collision-Region Diagram (STCRD) is shown in Fig. 10 
which combines both path and trajectory information for a single 
break point case for each of the two trajectories. In this situation, an 

overlap in the time ranges does occur and a space-time collision 

region is formed. This region represents the positions along each 

path where a possiblity of a space-time collision exists. 

The collision region in Fig. 10 is formed by an overlap in the 
time ranges such that the time values for the robots alternate. 

However, when an overlap occurs in which one robot's time range is 
contained totally within the time range of the other robot, a 
space-time collision is guaranteed to occur. This happens because 
one robot traverses its whole potential collision segment while the 
other robot, which was already within its potential collision segment, 

still remains in its potential collision segment. Thus, a space-time 
collision is assured to occur somewhere within the enclosed time 

range. This situation is further discussed in the next section. 
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Figure 10 Space-Time-Collision-Region Diagram (STCRD) 


2.2.2. Establishing Existence of Space-Time Collisions 

The objective of collision detection is to establish whether or not 
a space-time collision occurs between two robots. The collision region 
in the STCRD represents the positions along each path where a 
space-time collision can exist due to the overlap in the time ranges 
when potential collisions along the paths of the robots occur. The 
region is delimited by the time of the initial potential collision of one 
of the two robots and by the time of the final potential collision of 
one of the two robots. The starting time and ending time of the 
region are denoted by t 0 and tp, respectively as shown in Fig. 11. 

This time range defines a curve in the STCRD for each robot. The 
curves represent the motion characteristics of the robots along their 
paths where space-time collisions are likely. 

At a given time, the position of each robot can be determined 
by the position equations (30) and (31). Therefore, any time instant 
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Figure 11 Time Range Curves in the STCRD 

determines a ( X,y ) pair which can be transformed to another domain 
for analysis. This domain is shown in Fig. 12 as a 
Potential-Collision-Region-Motion Diagram (PCRMD). It is guaranteed 

that each (X,y) pair within t 0 and tp must be within the bounding box 
defining the potential collision region since t a and tp represent the 
common time range of the potential collision segments which form 
the bounding box. In other words, each value of A, and y between t a 

and t Q in the STCRD lies between X. and X, , and y. and y t , 

p icp tcp’ 1 icp 4 fcp* 

respectively in the PCRMD. 

Thus, the two curves defined by t u and tp in the STCRD will 

result in one curve in the PCRMD. Therefore, the motion 
characteristics of each robot corresponding to possible space-time 
collisions can be analyzed with respect to the potential collision 
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Figure 12 Potential-Collision- Region-Motion Diagram (PCRMD) 

region. Let the starting point and the ending point of the curve in the 
PCRMD be defined as C(X(t a ),y(t a )) and C(X(t (J ),y(t (J )), respectively. The 

objective is to find whether or not this curve intersects the potential 

collision region. If the potential collision region is intersected by the 
curve, a space-time collision occurs since both robots are within 
colliding distance at some point in time defined by the (k,y) pair. 

Since t o always represents the time of an initial potential 
collision of one of the robots, the starting point of the curve can lie 
on either segment A or B in Fig. 12. Likewise, since tp always 

represents the time of a final potential collision of one of the robots, 
the ending point of the curve can lie on either segment C or D. Since 
each of the functions in the STCRD is monotonically increasing, the 

(A.,y) pairs that connect any two points on the curve in the PCRMD, 
such as the starting and ending points, must monotonically increase 

with respect to time. The valid area between any two points which 

the curve can travel is shown in Fig. 13. Fig. 14 shows a possible 
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situation in which the curve passes through the potential collision 
region. Since an intersection is found, a space-time collision does 
occur during the time range specified by the ( ) pairs at the 
locations where the curve enters the region and leaves the region. 
Thus the time range for a space-time collision can be reduced from 
the overlapped time range to the actual time range if those locations 
can be found. Reducing the space-time collision region will be 
elaborated on further in a later section. 

C( X(t y ),Y(tv)) 

t 

?(t) 
cm tx 

Figure 13 Valid Travel Region for the Monotonically 
Increasing Curve in the PCRMD 

When the starting point of the curve lies on segment A or B in 
region 2, the curve must intersect the potential collision region to 
connect with its ending point. Therefore, a space-time collision does 
occur since at some point in time, the robots will be within colliding 
distance. Also notice that if the curve traverses either from segment 
A to C or from segment B to D, a space-time collision always occurs. 
This situation happens when an overlap in time ranges occurs such 
that one robot’s time range is totally contained within the other as 



)J(t x )) 


X(t) 
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Figure 14 Motion Curve with True Collision Range 

discussed in section 2.2.1. If the curve traverses from segment A, 

region 1 to segment D, region 4, a space time collision occurs. 
Similarly, if the starting point of the curve lies on segment B, region 
3 and the ending point lies on segment D, region 4, a space-time 
collision occurs. However, if the curve travels from segment A, 

region 1 to segment D, region 1 or from segment B, region 3 to 

segment C, region 3, a space-time collision may or may not occur as 
shown in Fig. 15. 

Determination of the existence of a space-time collision for 
these two cases is accomplished by a fast iterative algorithm. The 
algorithm assumes that if the curve comes within some threshold 
distance from the potential collision region, a space-time collision 
occurs. In other words, the potential collision region can be thought 
of as being expanded slightly. 

The algorithm uses the fact that the (k,y) pairs defining the 

curve in the PCRMD monotonically increases with respect to time. 
The idea is to divide the curve into regions of bounding boxes such 
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Figure 15 Exception Cases for Region One and Three 


that the curve traversal within each bounding box is known. Such a 

bounding box is shown in Fig. 13 as the valid travel region for a 

monotonically increasing curve. Fig. 16 illustrates the algorithm for 
both cases where the curve does and does not intersect the potential 
collision region in region 3. Applying the approach to region 1 is 
straightforward. The reader should consult Fig. 16 to better 
appreciate the ensuing discussion. Basically, bounding boxes from 

the starting point to the ending point of the curve (left to right in X 
and bottom to top in y) are created. Each bounding box is formed by 

two points along the curve. From the starting point, the position of 
the potential collision region is determined by calculating the y value 
using the X value of the starting point. Of particular interest is the 
location on the curve at the y value defined by the potential collision 
region position. Using the STCRD, the X value of this location is found 
thus forming a (X,y) pair of a point on the curve and the second 
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point defining the bounding box. Therefore, within this bounding 
box, the curve cannot intersect the potential collision region. The 
new (X,y) pair is the starting point for generating the next bounding 
box. This iteration continues until the y value of the potential 
collision region position is larger than the y value of the ending point 
of the curve. When this condition is satisfied, it ensures that the 
curve could never intersect the potential collision region and thus, no 
space-time collision occurs. Notice that at each iteration of generating 
a bounding box, only one new ( X,y ) point on the curve needs to be 

calculated since the previous (^,,y) point is being used as the other 
point in the bounding box pair. Therefore, a progression towards the 
endpoint of the curve is being performed. 

However, if the curve intersects the potential collision region, an 
infinite amount of bounding boxes are generated, each of which is 
decreasing in size as the curve approaches the potential collision 
region. Therefore, the iteration stops when the distance between 

potential collision region positions is within some specified threshold. 
This is similar to expanding the potential collision region. The 
threshold defines a distance the curve has to be from the potential 

collision region in order to state a space-time collision occurs. The 
maximum possible distance happens when the threshold value is 
produced by an equilateral triangle. Notice that if a curve traverses 
near the potential collision region, but never intersects the potential 

collision region, it is treated as a space-time, collision although one 
never existed. The maximum number of iterations to determine 
whether a space-time collision exists can be expressed as 
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Max Iterations < L/AT (34) 

where L is the length of the potential collision region segment and 
AT is the threshold value. 

In' the above examples, a full ellipse was used as the potential 

collision region in the PCRMD and in the iterative algorithm. The 
approach is also applicable for the other cases. Fig. 17 shows an 
example of a non-full ellipse case and Fig. 18 illustrates a parallel 

path situation. The point potential collision case is trivial. When one 

occurs, the X and y values of the point must produce the same time 

instant in the STCRD for a space-time collision to exist. 

2.3. Role of Collision Detection in Avoidance 

When a space-time collision is detected, the paths and/or 
trajectories of one or both of the robots must be modified to avoid 

the collision. The space-time collision region in the STCRD is formed 

by common time ranges when potential collisions along the paths 
occur. The objective is to eliminate the space-time collision region by 
producing non-overlapping time ranges. As presented previously, 
this time range is the extreme situation. The intersection points of 
the curve with the potential collision region in the PCRMD represent 
the actual time range of the space-time collision when mapped to the 

STCRD. Reducing the space-time collision region may help in some of 
the avoidance techniques that are discussed in Chapter 3. 

Therefore, depending on the avoidance technique, it may be 
advantageous to reduce the space-time collision region whenever 
possible. When the curve in the PCRMD travels from a point on 
segment A, region 1 or from a point on segment B, region 3, the 
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Figure 17 Non-Full Ellipse Case 



Figure 18 Parallel Path Situation 
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iterative algorithm approaches the actual collision points. The value 
produced when the iteration stops can be used as a new t value 

when mapped to the STCRD. In addition, when the above curves 
travel to point on segment D, region 1 and segment C, region 3, 
respectively, the algorithm can also be applied backward from the 

ending point. Therefore, when the iteration stops, a new tp is formed 

when mapped to the STCRD. Thus, the space-time collision region is 

reduced. This identical procedure can be applied to parallel lines that 

slope from left to right in the PSPCRD. Basically, if the iterative 
algorithm is being used to determine the existence of space-time 
collisions, there is no penalty in using the acquired information to 
reduce the space-time collision region. 


2.4. Summary of Collision Detection Algorithm 

The collision detection algorithm is summarized in pseudo-code 
form as follows: 

Procedure 1 -> Detect Potential Collisions (2.1) 

Step 1: Generate Potential Collision Regions (2.1.1) 

Step 2: Determine what type of region is generated (ellipse, 
line, or point) (2.1.2) 

Step 3: Determine Potential Collision Segments which are the 
points on each path where potential collisions begin 
and end (2.1.3) 

Procedure 2 -> Detect Space-Time Collisions (2.2) 

Step 1: Determine if the time ranges overlap when potential 
collisions along each path occur (2.2.1) 

Step 2: Using the beginning and ending times of the 

overlapped time range, determine the existence of a 
space-time collision by mapping between time 

domain and position domain (2.2.2) 
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Step 3: If the mapping in Step 2 is inconclusive, determine 
the existence of a space-time collision by applying 
an iterative algorithm to the mapping between time 
and position domains (2.2.2) 

Procedure 3 -> Reduce Space-Time Collision Region (2.3) . , 

Reduce Space-Time Collision Region depending on avoidance 
technique by using information from the iterative algorithm 
(2.3) 
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3. COLLISION AVOIDANCE 

To obtain collision-free motion, a collision in time and space is 
avoided by modifying the paths and/or trajectories of one or both of 
the robots. The method of achieving this collision-free motion 
depends on the avoidance requirements which modify various 

trajectory and path parameters. An overview of collision avoidance 
is presented in section 3.1. In section 3.2, some approaches to 

collision avoidance are discussed. 

3.1. Overview of Collision Avoidance 

A space-time collision region in the STCRD is depicted by 
common time ranges when potential collisions along the paths occur 
(or a reduced range when possible). The objective of collision 
avoidance is to eliminate the space-time collision region by 
producing non-overlapping time ranges. This is accomplished by 
modifying the paths and/or trajectories of one or both of the robots. 

3.1.1. Trajectory Modification 

Trajectory modification involves alteration of the motion 
characteristics of a robot along its path. Several parameters define 

the motion characteristics of a robot. These include number of break 
points, position of break points, chosen constant acceleration, and the 
starting time of motion. Any combination of the above parameters 
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on one or both of the robots can be modified to achieve collision-free 
motion. Specifically, the new motion characteristics of the robots are 
such that the time ranges when potential collisions occur along each 
path (or reduced time ranges) do not coincide. 

Each parameter influences the motion characteristics 

differently. To begin with, break points contribute significantly to 
the motion characteristics of a robot. The point at which a robot arm 
decelerates after previously accelerating, or accelerates after 
previously decelerating, is called the break point. Fig. 19 shows a 

preplanned straight line trajectory with one break point at The 

robot is accelerating along the path between the starting position 
and the break point and it is decelerating along the path between 
the break point and the final destination. For collision avoidance 

purposes, the break point can be moved to position X. a or X^. The 

effects of repositioning the break points on one or both of the robots 
may result in a collision-free motion as seen in Fig. 20 when the 
break point of each robot is modified. 

Repositioning the break points alone may not always produce a 
desirable outcome. Another option is to modify one or both of the 
preplanned trajectories by providing additional break points. 

Choosing the proper number and position of the break points can 
result in collision-free motion. Fig. 21 shows the effects of adding 

break points y B1 and y B2 to the preplanned trajectory of robot 2. In 
this situation, robot 2 accelerates along the path between the 
starting position and y B1 , decelerates between y B1 and y fi2 , accelerates 

between y B2 and the original break point, and finally decelerates 
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Figure 19 Preplanned Trajectory with One Break Point . • ------ 

between the original break point and the final destination. The two 

new break points cause a separation of the overlapped time ranges 
and thus provide collision-free motion. 

In addition to break point modification, which may sometimes 
require acceleration reduction, the acceleration itself along the path 
of a robot can be manipulated. Assuming the preplanned trajectory 

of a robot uses maximum constant acceleration for minimum time 

travel, smaller acceleration values can be chosen for collision 
avoidance purposes. In other words, a reduction in the speed of a 

robot, without causing substantial delay, can be used to avoid a 

collision. 

A final parameter affecting the motion characteristics of a robot 
is the time at which motion begins. Assuming a robot cannot begin 

its motion earlier in time, postponing the starting time of motion, 
within a reasonable delay, can provide collision-free motion. Fig. 22 
shows an example of time postponement. If the motion of robot 2 

begins ^ 2 *^i * ater * n t i me » common time ranges separate and 

therefore, collision-free motion is obtained. 

In summary, collision-free motion may be achieved by altering 
any combination of the above trajectory parameters that contribute 
to the motion characteristics of one or both of the robots. 
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Figure 20 Collision-Free Motion by Repositioning 
the Break Points 
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STCRD with Break Point Modification 


Figure 2 1 Collision- Free Motion by Providing 
Additional Break Points 
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Figure 22 Collision-Free Motion by Time 
Postponement 


3.1.2. Path Modification 

Path modification involves alteration of the path of a robot. 
Since the initial and destination points of a path remain the same, 
the straight line path of a robot is modified to two or more connected 
straight line paths which avoid the collision as shown in Fig. 23. This 
is consistent with the initial assumption requiring straight line paths. 
Various parameters describing a new travel route are the number of 
straight line path segments, the average deviation from the original 
path, and the new travel distance. 

Many circumstances require the use of path modification. For 
instance, if the potential collision region extended across the entire 
PSPCRD in either X or y, altering the motion characteristics will not 
avoid the collision. Specifically, the whole path of one robot is a 
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Figure 23 Path Modification 

potential collision segment. Fig. 24 shows a case with such a 
situation. Another example requiring path modification to obtain 
collision-free motion is paths that are parallel with the robots 
traveling toward each other. In summary, path modification avoids a 
space-time collision by eliminating the possibility of potential 
collisions by altering the paths of one or both of the robots. 

3.1.3. Avoidance Requirements 

A collision-free motion is achieved based on the avoidance 
requirements which modify the trajectory and path parameters 
discussed in the previous sections. The avoidance requirements for 
two robots are classified into three categories: 

Requirement 1) The final arrival times of one or both of the 

robots can be modified, but both robots must 
adhere to their original paths. 

Requirement 2) The paths of one or both of the robots can be 

modified, but both must adhere to their final 
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arrival times. 

Requirement 3) The paths and final arrival times of one or 

both of the robots can be modified. 



Figure 24 Situation Requiring Path Modification 

In avoidance requirement one, the trajectory parameters are 
manipulated. Specifically, the motion characteristics of one or both of 
the robots are altered to avoid a collision. In avoidance requirement 
three, three cases exist: 1) modify one or both of the paths, 2) 

modify one or both of the final arrival times, and 3) modify one of 
the paths and one of the final arrival times. In case 1, only one of the 
paths should be modified since it is expensive in time to modify both 

paths. This case also handles the situation of a stationary robot. Case 
2 is identical to avoidance requirement one and thus is solved by 
modifying the motion characteristics of one or both of the robots. In 
case 3, the motion characteristics of one robot are altered while the 

path of the other robot is modified. Since modifying the path of a 

robot requires a greater travel distance, a solution to avoidance 
requirement two may not exist. 
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3.2. Parameter Modification 

The number of possible variations in trajectory parameters or 

robot paths to achieve collision-free motion is very high. An obvious 
way to. optimize these modifications is the use of some criterion to 
obtain a best solution. One approach currently being investigated 
formulates collision avoidance as an optimization problem. For 

instance, a collision-free motion can be obtained by minimizing the 

delay in the final arrival times of both robots based on modifying 

the trajectory parameters of one or both of the robots under 
avoidance requirement one. In this case, a penalty can be given to 
each robot for the delay in their new final arrival times due to 
placement of break points, acceleration reduction, and/or time 

postponement. In a similar manner, collision-free motion can be 
obtained by minimizing the deviation of one or both of the robots 
from their original paths based on distance traveled. In this case, a 
penalty is given to the robots for an increase in travel distance due 
to path modification. Combinining the above two cases into one 

optimization problem can be performed to achieve collision 

avoidance under avoidance requirement three. In this situation, the 
optimization is performed by minimizing the delay in the final 

arrival times of both of the robots based on trajectory modification 
and/or minimizing the deviation from their original paths based on 
distance traveled. The optimization function is subject to various 
constraints on acceleration values, location of break points, etc. 

Therefore, a collision-free motion is determined using the 
various methods of modifying the trajectory and path parameters 
that best fit an optimization function. In the above situations, 



heuristics should be defined in order to limit the amount of search 
for a solution. Notice in this approach that a reduced space-time 
collision region is helpful in finding possible break point positions so 
that a separation in the overlapped time ranges will occur. 

Another approach to collision avoidance is to fit the trajectory 
curve of a robot through a specified point to force a separation in the 
common time ranges. Fig. 25 shows the position of the point where 

the trajectory curve of robot 2 must pass in order to achieve 
collision-free motion. This method can incorporate break point 
modification, acceleration adjustment, and if necessary, time 
postponement. This approach can utilize a reduced space-time 
collision region and represents avoidance requirement one because 

only the trajectory parameters are being manipulated. 

A final approach to collision avoidance is illustrated in Fig. 26. 
In this method, the PCRMD is utilized to produce collision-free 

motions. The idea is to restrict the values of X and y to be within 

certain ranges such that a motion curve can never pass through the 
potential collision region. One possibility is to modify the curve 
within the bounding box of the potential collision region. Therefore, 
modifications to the trajectroy curves are altered in the STCRD 
between the common time ranges. A second possibility is to redefine 
the whole motion of the robots such that the motion curve in the 
PCRMD bypasses the potential collision region. In this case, both 
robots will finish at the same time. In either of these two situations, 
the size of the space-time collision region is not of great significance 
since once a collision is detected, collision-free motion is achieved 
based only on avoiding the potential collision region. Altering the 
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motion curve in the PCRMD has the effect of modifying the trajectory 
of both of the robots and thus provides collision avoidance under 
avoidance requirement one. 
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4. CONCLUSIONS AND FUTURE RESEARCH 

A critical area of interest in robotics research involves 

coordination of multiple arms which is essential for the "intelligent 
robot" of the future. Independently controlled robots in a common 

area should be coordinated in order to avoid collisions between 

them. Therefore, motion planning must include detection and 
avoidance of collisions between two or more robots performing tasks 
in a common workspace. 

Collision-free motion of two robot arms in a common workspace 

is investigated in this report. The collision-free motion is obtained by 

detecting collisions along straight line trajectories of each robot by 

using a sphere model for the wrists and then modifying the paths 
and/or trajectories of one or both robots to avoid the collision. The 

collision detection algorithm is described and suggested approaches 
to collision avoidance are outlined for future research. 

The collision detection method obtains a range of potential 
collisions along the straight line trajectories of the two arms without 
considering the motion characteristics by producing a Parametric- 
Space-Potential-Collision-Region Diagram (PSPCRD). The potential 
collision range is then mapped into the time domain to obtain the 

space-time collisions by producing a Space-Time-Collision-Region 
Diagram (STCRD) and using an analysis domain consisting of a 
Potential-Collision-Region-Motion Diagram (PCRMD). Once the 
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collision region in time and space is found, a collision free motion is 
obtained by producing new paths and/or trajectories for the robots 
based on the avoidance requirement and various avoidance 

techniques. _ ... . 

In conclusion, this report presents a novel approach to 

collision-free motion planning of two robots operating in a common 

workspace. The efficiency of the collision detection algorithm allows 
for an on-line motion planner. Thus, this work provides a significant 
contribution towards multiple arm coordination. 

In order to provide a complete solution to the multiple robot 
arm coordination problem, further development and investigation is 

needed. Future research direction will consider the following goals: 

1) Develop the formal theory for the collision avoidance 

techniques using the sphere model for two robots. 

2) Extend the techniques of detection and avoidance for 

other types of wrist models (cylinder, cone, polyhedra, etc.) 
for two arms. 

3) Generalize the techniques of detection and avoidance of 

collisions to handle more than two robots in a common 

workspace. 
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